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SUMMARY 


This report presents the implementation of a joint-space adaptive control scheme used to control non - 
compliant motion of a Stewart Platfonn-based Manipulator (SPBM) which is used in a facility called 
the Hardware Real-Time Emulator (HRTE) developed at Goddard Space Flight Center to emulate space 
operations. The SPBM is comprised of two platforms and six linear actuators driven by dc motors, and 
possesses six degrees of freedom. The report briefly reviews the development of the adaptive control scheme 
which is composed of proportional-derivative (PD) controllers whose gains are adjusted by an adaptation 
law driven by the errors between the desired and actual trajectories of the SPBM actuator lengths. The 
derivation of the adaptation law is based on the concept of model reference adaptive control (MRAC) and 
Lyapunov direct method under the assumption that SPBM motion is slow as compared to the controller 
adaptation rate. An experimental study is conducted to evaluate the performance of the adaptive control 
scheme implemented to control the SPBM to track a vertical and circular paths under step changes in 
payload. Experimental results show that the adaptive control scheme provides superior tracking capability 
as compared to fixed-gain controllers. 


1 Introduction 

Closed-kinematic chain manipulators that comprise two platforms coupled together by six linear parallel 
actuators whose length variations (shortening and extension) produce the motion of one platform relative 
to another are classified as Stewart Platform-based (SPB) manipulators. The development of the above 
mechanism proposed by Stewart [1] in the design of an aircraft simulator was motivated by disadvantages 
suffered by conventional anthropomorphic open-kinematic chain (OKC) manipulators whose joints and 
links are actuated in series. OKC manipulators generally have long reach, large workspace and are capable 
of entering small spaces because of their compactness. However, they have low stiffness and undesired 
dynamic characteristics, especially at high speed and large payload mainly due to the cantilever-like 
structure. In addition, the nonuniform distribution of payload to actuators causes OKC manipulators to 
have low strength-to-weight ratios. Finally the serial accumulation of joint errors throughout the OKC 
mechanism results in a relatively large position error on the last link of the manipulator. On the other 
hand, SPB manipulators whose mechanism are parallel, have been proven to be capable of high precision 
positioning due to their high structural rigidity and non-serial accumulation of joint errors. 

Since its introduction, the Stewart Platform has attracted tremendous attention from researchers [2]- 
[23] involving robot manipulators, robotic end-effectors and robotic devices for high precision robotic tasks 
where the requirements of accuracy and sturdiness are more essential than those of large workspace and 
maneuverability. Dieudonne et ah [2] obtained an actuator extension transformation for a SPB simulator 
built at NASA Langley Research Center to train aircraft operators. Hunt [3] conducted a systematic 
study of in-parallel-actuated robot arms and McCallion and Truong [4] considered the mechanism of the 
Stewart Platform in the design of an automatic assembly table. Sugimoto and Duffy [5] proposed a general 
technique to describe the instantaneous link motion of a single closed-loop mechanism by employing linear 
algebra elements to screw systems. Premack and his coworkers [6] built a SPB robot end-effector serving 
as a testbed for studying autonomous assembly for space operations and the compliance control problem of 
this end-effector was later investigated by Nguyen and others [9]. Yang and Lee [7] and Fichter [8] studied 
the kinematic problems and practical construction of SPB manipulators. Sugimoto [10] conducted studies 
of kinematics and dynamics of parallel manipulators. Nguyen and Pooran [14] conducted kinematic 
analyses and proposed an algorithm determining the reachable workspace of SPB end-effectors used to 
perform high and precise motion. Closed-form solutions for forward kinematics were derived by Griffis 
and Duffy [12] and by Nanua et ah [16] for a class of Stewart Platforms. Waldron et al [13] discussed 
the kinematics of a hybrid series/parallel six- degree- of- freedom manipulator (DOF) system. Nguyen and 
Pooran [15] performed a dynamic analysis for a general SPB manipulator. Gosselin and Angeles [17] 
provided a general classification of different kinds of singularities encountered in closed-kinematic chain 
mechanism. Nguyen and his coworkers [21] developed computationally efficient kinematic equations and 
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presented a hardware implementation for a 6 DOF robotic wrist recently built at NASA/Goddard Space 
Flight Center. In addition, they developed force and kinematic transformations for a force/torque sensor 
whose implementation was based on the Stewart Platform mechanism [23]. Although much of the research 
in the literature has devoted extensive effort to the kinematics, dynamics and mechanism design of SPB 
manipulators, little attention has been paid to the control problem of this type of manipulators. Reboulet 
and Pigeyre [19] investigated the force/position control of a six DOF SPB micromanipulator. Nguyen, 
Pooran and Premack [9] proposed a control scheme providing active compliance to SPB manipulators 
and presented computer simulation results of a 2 DOF parallel manipulator. They then developed a 
learning control scheme [18] and several trajectory planning schemes [20] for SPB manipulators. In order 
to effectively react to uncertainties in dynamic modeling and payload encountered in the control of a 
SPB manipulator, adaptive control schemes, whose controller gains are regulated by an adaptation law 
should be employed in lieu of a fixed-gain control scheme. Numerous adaptive control schemes were 
developed for OKC manipulators [24]-[28], and only a few for SPB manipulators [11]. Using the concepts 
of model reference adaptive control (MRAC) and Lyapunov direct method, Nguyen et al. developed a 
computationally efficient adaptive control scheme for compliant motion control [11] of SPB manipulators 
and end-effectors. They later extended the developed adaptive control scheme to motion control of 
redundant manipulators [22]. 

This report deals with adaptive control of a Stewart Platform-based Manipulator (SPBM) which is 
an integral part of a facility called the Hardware Real-Time Emulator (HRTE) recently developed at 
Goddard Space Flight Center (GSFC) to study and emulate space operations. The organization of the 
report is described as follows. First, the main components of the HRTE and the SPBM are described in 
the next section. Then, a kinematic analysis is performed for the SPBM to provide a closed-form solution 
to the inverse kinematics and a computationally efficient solution to the forward kinematics employing 
the Newton-Raphson Method. After that, the development of a joint-space adaptive control scheme based 
on the concepts of model reference adaptive control and Lyapunov direct method will be briefly reviewed. 
The final part of the report presents results of experimental study conducted to evaluate the performance 
of the adaptive control scheme implemented to control the SPBM to track several test paths. 

Matrix and vector notations used in this report are listed below: 

• M t : transpose of the matrix M 

• 0 n ; (nxn) matrix whose elements are all zero 

• I n : (nxn) identity matrix 

• fr[M]: trace of matrix M. 

• diag(yi) for i= 1,2,. . . ,6 = diagonal matrix whose diagonal elements are u>,-, for i=l,2,. . . ,6. 

2 The Stewart Platform-based Manipulator 

Figure 1 presents the Hardware Real-Time Emulator (HRTE) developed at the Intelligent Robotic Labo- 
ratory (IRL) of the Goddard Space Flight Center (GSFC), to emulate space operations such as berthing 
and docking performed by a telerobot or by the Space Shuttle Remote Manipulator System (SSRMS). 
The HRTE is basically composed of a Cincinnati Milacron T3 robot possessing six DOFs and a six DOF 
Stewart Platform-based Manipulator (SPBM). The SPBM is mounted to the last link of the T3 robot 
such that one DOF of the T3 coincides with one of the SPBM, yielding a total of 11 DOFs to the 
HRTE. Currently the HRTE is planned to emulate space hardware docking and berthing performed by 
the SSRMS. The T3 robot will be used to emulate SSRMS mechanical vibrations produced by external 
disturbances, and the SPBM to emulate the vibration compensation of a mechanism attached between 
the SSRMS and the hardware so that a successful berthing/docking can be carried out. The HRTE is 
currently used as a testbed to investigate the feasibility of a series/parallel manipulator system in which 
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the T3 robot serving as a serial manipulator is mainly responsible for emulating gross motion while the 
SPBM serving as a parallel manipulator for emulating fine and precise motion. Testing of autonomous 
assembly of parts, mating of space-rated connectors and docking of spline-locking screws are under way. 

Figure 2 shows the main components of the SPBM whose design is based on the Stewart Platform 
mechanism. It comprises a payload platform, a base platform, six linear actuators and an end-effector 
attached to the payload platform. Six linear actuators, each of which is composed of a ballscrew assembly 
mounted axially with a dc motor, link the payload platform and the base platform together. Motion of 
the payload platform with respect to the base platform is produced by driving the motors to shorten 
or extend the actuator lengths. Proper coordination of the actuator length trajectories enables the 
payload platform to perform complex maneuvers. Position sensing is provided by six linear displacement 
transducers (LDT) mounted along the linear actuators to measure their lengths. Forces/ torques exerted 
by the end-effector are measured through a JR 3 Universal Force-Moment Sensor System mounted between 
the end-effector base and the payload platform. 2DOF universal joints are used to attach the actuator 
links to the platforms. The LDT signals are sent to the IRL Local Area Network (LAN) via an Ethernet 
board and a Data Translation input board which reside in a personal computer (PC) 80486. An IRIS 
workstation takes the LDT signals off the LAN by means of another Ethernet board, performs necessary 
coordinate transformations and forward kinematics and then graphically displays in real-time the payload 
platform pose of the SPBM relative to the base platform. Based upon the desired Cartesian path to be 
tracked by the SPBM, an Apollo workstation carries out the Cartesian trajectory planning and the 
SPBM inverse kinematics and sends the desired actuator length trajectories down to the PC. The PC 
then implements a selected control scheme, such as the joint-space adaptive control scheme presented 
in the next section, which is driven by tracking errors computed according to the LDT signals and the 
desired actuator lengths to produce the actuating signals that are finally sent to the dc motor drives via 
a Data Translation output board. 

3 SPBM Kinematic Analysis 

This section will use vector algebra to attain a closed-form solution for the SPBM inverse kinematics. 
Then the Newton Raphson’s Method will be applied to the nonlinear kinematic equations to obtain a 
computationally efficient solution for the SPBM forward kinematics. 


3.1 SPBM Inverse Kinematics 

The inverse kinematics of the SPBM can be formulated so as to determine the required actuator lengths 
for a given pose 1 of the payload platform with respect to the base platform. Figure 3 shows that two 
coordinate frames {P} and {B} are assigned to the payload and base platforms of the SPBM, respectively. 
The origin of Frame { P } is located at the centroid P of the payload platform, the zp-axis is pointing 
outward and the xp-axis is perpendicular to the line connecting the two attachment points P i and P$. 
The angle between P\ and P 2 is denoted by Op. A symmetrical distribution of joints on the payload 
platform is achieved by setting the angles between P\ and P3 and between P3 and P5 to 120°. Similarly, 
Frame {B} has its origin at the centroid B of the base platform. The xp-axis is perpendicular to the 
line connecting the two attachment points By and B 6 , the angle between B\ and B 2 is denoted by 0p. 
Moreover, the angles between B\ and B% and between P3 and P5 are set to 120° in order to symmetrically 
distribute the joints on the base platform. The pose of the payload platform is specified by the orientation 
of Frame {P} with respect to Frame {B} and the position of the origin of Frame {P} with respect to 
Frame {B}. Now denoting the angle between PPi and xp by A*, and the angle between PP, and xp by 
A,- for i=l,2,. . . ,6, we obtain 

A i = 60t° - A, = 60i° - for i = 1,3,5 (1) 

*111 this report, pose implies both Cartesian position and orientation. 
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and 


A» = Ai -1 +Gb; A.* = Ai -1 + e Pi fori = 2, 4, 6, (2) 

Furthermore, if Vector P p, = ( p iX pi y p tz ) T describes the position of the attachment point Pi with respect 
to Frame {P}, and Vector B b { = (b ix b iy b iz ) T the position of the attachment point with respect to 
Frame {B}, then they can be written as 

F Pi = [ rpcos(Ai) rpsin(Xi) 0 ] T 


and 


(3) 

(4) 


B bi = [ rj 3 Cos(Ai) r B sin(Xi) 0 ] 

for i=l,2,. . . ,6 where r P and r B represent the radii of the payload and base platforms, respectively. 

We proceed to consider the vector diagram for an ith actuator given in Figure 4. The position of 
Frame {P} is represented by Vector B d = [x y z] p which contains the Cartesian coordinates x, y, z of 
the origin of Frame {P} with respect to Frame {B}. The length vector p q,' = ( Qix Qiy Qiz) T > expressed 
with respect to Frame {B} can be computed by 

(5) 

( 6 ) 
(7) 


where 


B qi = D Xi + B Vi 


*x,- = B d — p bj 
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which is a shifted vector of 13 d and 


Pi 


lR f p , 


( 8 ) 

(9) 


which is the representation of B pi in Frame {B} and B R is the Orientation Matrix specifying the 
orientation of Frame {P} with respect to Frame {B}. 

Thus the length /; of Vector B q, can be computed from its components as 
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We obtain from (3)-(4) 


= y/(Xi + Hi ) 2 + (yi + Vi ) 7 + (zi + u?i ) 2 


Pix+Piy+Pl = r P> 


*h+ti,+K=rl 

and from the properties of orientation matrix 


r ll 4“ r 21 + r 31 — r 12 + r 22 4" r 32 — r 13 + r 23 + r 33 ” 1 


' 21 


( 10 ) 

( 11 ) 

( 12 ) 

(13) 

(14) 


and 


r n r 12 + r 21 r 22 + r 31 r 32 = 9 

^11^13 + r 21 r 23 + r 31 ^33 = 0 

rjiris + ?'22 r 23 + ^32T32 = 0. 


( 15 ) 
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( 16 ) 


Employing (12)-(15), (10) can be rewritten as 

2 — X 2 + y~ + J 2 + "b r fl "b 2(rjip, r + f 'l 2 P«y)( J ' — ^ir) 

+2(r 2 iPi* + r 2 2Piy)(y - Oy) + 2(r 3 iPi* + r 32 p iy )z - 2{xb ix + 2/^iy ) j 

for i=l,2,. . . ,6. 

Equation (16) represents the closed-form solution to the inverse kinematic problem in the sense that 
required actuator lengths /; for i=l,2,. . . ,6 can be determined using (16) to yield a given pose of Frame 
{P} with respect to Frame {B}. 

The orientation of Frame {P } with respect to Frame {B} can be described by the orientation matrix 
pR as shown in (9) which requires nine variables r,j for i j=l ,2,3 from which six are redundant because 
only three are needed to specify an orientation. There exist several ways to specify an orientation using 
three variables, but the most widely used one is the Roll-Pitch- Yaw angles a, /?, and 7, which represent 
the orientation of Frame {P}, obtained after the following sequence of rotations from Frame {B}: 

1. First rotate Frame {B} about the x^-axis an angle 7 (Yaw) 

2. Then rotate the resulting frame about the y^-axis an angle fi (Pitch) 

3. Finally rotate the resulting frame about the z/j-axis an angle a (Roll). 

The orientation represented by the above Roll-Pitch- Yaw angles is given by 2 

ca c/3 ca sj3 sy — sa cy col sj3 cy + sa sy 
pR = R/?p>' = sa cj3 sa s/3 sy + ca cy sa sft cy — ca sy . (17) 

-s/? c/3 sy c/3 cy 

3.2 SPBM Forward Kinematics 

The forward kinematics of the SPBM deals with the determination of the pose of the payload platform 
with respect to the base platform based on the actuator lengths for i— 1,2,.. .,6 measured by the six 
LDTs. In other words, the SPBM forward kinematic problem can be formulated as finding a Cartesian 
position specified by x, y, z and an orientation specified by Roll-Pitch- Yaw angles a, /?, and 7 to satisfy 
Equation (16) for a given set of actuator lengths U for i=l,2,. . . ,6. The fact that Equation (16) represents 
a set of six highly nonlinear simultaneous equations with six unknowns results in no closed-form solution 
for the forward kinematic problem. Consequently, iterative numerical methods must be employed to solve 
the above set of nonlinear equations. In the following, the implementation of Newton-Raphson method 
for solving the forward kinematic problem is presented. 

In order to apply the Newton-Raphson method, first from (11) we define 6 scalar functions 

fi{ a) = ( Xi + Uj) 2 + (y, + vtf + (ii + Wi) 2 - /, 2 = 0 (18) 

for i=l,2 ,. . . ,6, where the vector a is defined as 

a=[ax a 2 a 3 a 4 a 5 a 6 ] T = [ x y z a (3 y ] T , (19) 

and then employ the following algorithm to solve for a: 

SPBM Forward Kinematics Algorithm 

Step 1: Select an initial guess a. 

Step 2: Compute the elements r, ; of pR using (17) for ij- 1,2,3. 

2 c a = cos a, and sa = sin a. 
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Step 3: Compute Xj.y,-, f,-, using (7) and u it v it u>, using (9) for i=l,2,. . . ,6. 

Step 4: Compute /,( a) and Ajj = using (18) for i, j=l,2,. . . ,6. 

Step 5: Compute B { = -/;(a) for i=l,2,. . . ,6. If £® =1 | B, \< tolf (tolerance), stop and select a as the 
solution. 

Step 6: Solve £®=i = 5; for 8a j for ij = l,2,. . . ,6 using LU decomposition. If Sa j < tola 

(tolerance), stop and select a as the solution. 

Step 7 : Select a new — a + 6a and repeat Steps 1-7. 


It is still unsolved as to how to select an initial guess which ensures convergence of the algorithm. 
However according to the experiences gained from computer simulation presented in [21] any nonzero 
initial guess within the reachable workspace of the SPBM will make the algorithm converge. This is 
probably one of the properties of the Stewart PI at form- based mechanisms. Furthermore, the above 
algorithm as manifested by numerous experimental studies [22], has worked well in a real-time tracking 
problem where it is employed to compute the actual pose of the payload platform with respect to the base 
platform based on the actuator lengths. This occurs because the current guess is based on the previous 
actual pose which is very close to the correct solution provided that the SPBM is tracking the desired 
path very closely. 

In order to minimize the computational time of the SPBM Forward Kinematics Algorithm, the ex- 
pressions for computing the partial derivatives in Step 4 of the algorithm should be simplified. First 
using (9) and (17), the partial derivatives of u i} v it and Wi with respect to the angles a, /?, and 7 can be 
computed as follows: 

diti 3'U\ dui 

= cau>i ; — =p iy r 13 , {M) 


da 


= ~Vi\ 


33 


3y 


dwj 

da 


dvi _ 3 Vi 

H~ Ui] Ip 


sa Wi] 


dvi 


Piy r 23 > 


0 ; 


dwi 

w 


~(C/? Pit +SP Sf Piy)] 


dwi 

dj 


Piy r 33 - 


( 21 ) 

( 22 ) 


From (7), we note that 


chi _ djji _ dzj 
dx dy dz 


Employing (20)-(23), we obtain after intensive simplification 


df L = df L 

da\ dx 


dfi_ 

dxi 


2 (x< + «.), 


M 

da 5 


dfi 

dp 


dfi 

da 2 


dJi = dfi 

dy dxji 


2(y, + 


dfi^dJi 

da 3 dz 

dU_ = df_ 

da^ da 


w, = 2(f ‘ + u,i) ' 

2(-XiVi + j/iUj), 


2 {(-Xi ca + yi sa)wi - (p ix c 0 + pt y s 0 s^)zi\ 


df_ 

das 


d A 

d 7 


= 2 p,j,(Xjri 3 + j/;r 2 3 + *^ 33 ). 


(23) 

(24) 

(25) 

(26) 

(27) 

(28) 
(29) 
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Conventionally the Manipulator Jacobian Matrix is defined as a matrix relating joint velocities to 
Cartesian velocities composed of translational velocities and rotational velocities. For the robot wrist, s- 
ince actuator lengths are selected as joint variables, the time rates of change of actuator lengths 1,, 1 2 , .... U 
are joint velocities. However in order to utilize the partial derivatives computed for the forward kinematic 
transformation, we define here the velocities of Cartesian positions of the payload platform with Frame 
{B}, namely i, y and z as the translational velocities and the velocities of the Roll-Pitch-Yaw angles d, 
/?, and 7 as the rotational velocities . The matrix Ja/ which relates the length velocities to translation 
velocities and Roll-Pitch-Yaw angle velocities is therefore called The Afodified Jacobian Matrix. Denoting 

a = (ai <32 as as ae) r = (i y z d (3 j) T , (30) 


and 

i = (/i ?2 h U h h) r j 

(31) 

we obtain 

a = Ja/ 1, 

(32) 

or 

1 = J A / _1 a. 

(33) 

where Ja/ 

Q 1 m ^ 

is the Modified Jacobian Matrix. Calling the ij-element of J M ~ , 

from (33) we 

have 

6 6 m 

/=! j= l 1 

(34) 


Now solving for l { 2 in (18) yields 

h 2 = (fi + u if + {tji + Vi ) 2 + (zi + Wif = fi (35) 


for i=l,2,. . . ,6. Recognizing that /» is a function of Xi , y, , z it o, /?, and 7, and using (23), we differentiate 
both sides of (34) with respect to time to obtain 


;= 1 


(36) 


from which solving for /, yields 


i _sh± dfr. 


Now comparing (34) and (37) and noting from (35) and (18) that loj = foj-’ we arrive at 


(37) 


^_L dfi_ 

ij 2/, da. 


(38) 


where can be obtained from Step 4 of the Newton-Raphson Algorithm using (24)-(29). In other 
words, we just showed that the inverse of the Modified Jacobian Matrix can be computed using the 
results of the forward kinematic transformation. 
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4 The Joint-Space Adaptive Control Scheme 

The fact that the SPBM inverse kinematics has a closed-form solution motivates the use of a joint-space 
control scheme for the SPBM instead of a Cartesian-space control scheme in order to avoid problems 
associated with the use of the SPBM Forward Kinematics Algorithm in converting LDT signals into 
actual payload platform pose in the case of a Cartesian-space control scheme. To effectively react to the 
nonlinearity of the manipulator dynamics, errors in dynamic modeling, and sudden changes in payloads, 
adaptive controllers are selected instead of fixed-gain controllers which work well only when the manip- 
ulator stays within the linearized operating region. Figure 5 illustrates the structure of the adaptive 
control scheme implemented to control the noncompliant motion of the SPBM. As the figure shows, a 
Cartesian trajectory planner converts a desired Cartesian path which is specified by initial and final poses 
and pose velocities and to be carried out by the SPBM into six desired Cartesian trajectories. Then the 
SPBM inverse kinematics is used to transform the Cartesian trajectories into six desired trajectories of 
the SPBM actuator lengths which are then compared with the actual length trajectories measured by 
the LDTs to determine the length errors. Based upon the length errors, proportional-derivative (PD) 
controllers whose gains are adjusted by an adaptation law to be derived below, control the joint forces of 
the SPBM actuators such that the length errors remain zero all the time or existing errors decay to zero 
as quickly as possible. 

The dynamics of the SPBM can be described by [15]: 

r{t) = M(q, q) q(i) + N(q, q) q(f) + G(q, q) q(0 (39) 

where q(t) denotes (6x1) actuator length vector of the SPBM, r(t), the (6x1) joint force vector, M(q,q), 
the SPBM (6x6) mass matrix which is symmetric positive-definite, N(q, q) and G(q, q) are (6x6) matrices 
whose elements are highly complex nonlinear functions of q and q. 

In the right-hand side of (39), under the assumption that the joint friction is negligible, the second 
term represents the centrifugal and Coriolis forces, and the third term the gravity forces. 

From Figure 5, we obtain 

t(0 = Kp(0 q e (<) + K d (f) q e (<) (40) 

where 

q*(0 = <id(0 - q(0 ( 41 ) 

represents the error vector between the actual length vector q (t) and the desired length vector q<j(f), 
K p (f) and K<*(£) are the matrices of the proportional and derivative terms, respectively, of the adaptive 
controller. 

Substituting (40) into (39) yields 

M q e + (N + K rf ) q e + (G + K p ) q e = M q d + N q d + G q d (42) 


where the dependent variables of the matrices and vectors were dropped for simplicity. 

In order to transform (42) into a state space form, we proceed to define a (12x1) state vector z (t) 
such that rr 

■(iMtfW qfW] . ( 43 ) 

which converts (42) into 


i{t) = 


06 Is 
— Ai — A-_) 


z(<) + 


06 06 06 

A 3 A 4 16 


U (0 


(44) 


where 

and 


A, = M~ , (G + K P ), A 2 = M -1 (N + IQ), 
A 3 = M - 1 G, a 4 =m _ 1 n, 


(45) 

(46) 
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and 


u(0 = [ql(0 ql(l) q I(<)] T - («) 

In the framework of MRAC, Equation (44) represents the adjustable system. The desired performance 
of the SPBM motion can be specified by a reference model in terms of the tracking error vector q e (<) = 
[g el (f) 2(0 • • • ?e6(0] T ' Suppose the tracking errors q e i{t) for i=l,2,. . . ,6, are decoupled from each other, 
and satisfy 

?ei(0 + 2 & Ui q ei {t) + w? q ei (t ) = 0 (48) 

for i=l,2,. . . ,6, where £, and w,- denote the damping ratio and the natural frequency of q ei , respectively. 
Then the dynamics of the reference model can be represented by 


im(t) - D Z m(t) = 


Oe ^6 

— Di — D 2 


z m(0> 


(49) 


where Di=diag(w 2 ) and D 2 =diag(2£ ! Wi) are constant (6x6) diagonal matrices, and 

*»(<>= [q£<0 q^of (50) 


with 

<Im = (<Z«1 % e 2 - Qee) 7 ' 

Solving (49), we obtain 

z m (f) = exp(D^) z m (0). (52) 

We note from (52), that if z m (0) = 0, i.e. the initial values of the actual and reference length vectors 
are identical, then z m( 0 — 0. 

Now if e(t), the adaptation error vector is defined as 

e(0 = z m (0 - z (t) } (53) 


then from (44) and (49), we obtain an error system described by 


6(0 


06 Is 
-Di — D 2 


e(0 + 


06 0 6 
Ai — Di A 2 — D 2 


0g 0g 06 

— A3 — A4 — 16 


u(0- 


z(0 


We proceed to select a Lyapunov function candidate u(0 such that 

u(0 = e T Pe + tr [(Ai — Di) t I7i(Ai — D 1 )] 

+tr [(A 2 — D 2 ) T iT 2 (A 2 — D 2 )] 

JT3 A3] -f tr[ 27 4 A4], 


(54) 


(55) 


where tr[ M] is the trace of matrix M, P and 27, for i=l,2 r ..,4, are positive definite matrices to be 
determined later. 

Taking the time derivative of (55) and simplifying the resulting expression, we obtain 

v{t) = e T (PD + D T P)e 

+2 tr |(A, — Di) 7 '(I7qr + H\ Ai)j 
+2lr [(A a - D,) T (/?qr + JT 2 A 2 )] 

-2 tr [A 3 T (/2qJ - iT 3 A 3 )] 

-2 tr [A 4 T (/2«iJ - JT 4 A 4 )] (56) 
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where 


fl = [Pj P 3 ]e(0 = -[Pa Ps]*(0 = -P 2 qe - P 3 q e 


(57) 


and P is given by 



(58) 


and it is noted that e(t) = — z(t) since z rn (t) = 0. 

In (48) & and w,- can be selected so that D is a matrix having stable eigenvalues, which is also called 
a Hurwiiz matrix [24]. Therefore according to Lyapunov Theorem[ 25], for any given positive-definite 
symmetric matrix Q, there exists a positive definite symmetric matrix P that satisfies the Lyapunov 
equation 

PD + D r P = -Q. (59) 


Indeed, if Q is selected to be 


Q = 


2Qi 0 6 
0 6 2Q 2 


then the submatrices of Q can be computed as follows [25]: 


(60) 


Pi = QiDr 1 + QiDr 1 D 2 + Q 2 D 2 - 1 D 1) 
P 2 = QiD 1 - 1 , 

Pa = Q2D2 1 + QiDj *D2 


Now in (56), if we set 

/2qJ + JT| Ax = J?qj -f IT 2 A 2 = 0 

and 


J?qj - II 3 A 3 = 12 qj — II 4 A 4 = 0, 


then (56) becomes 

which is a negative definite function of e(t). 


{;(£) = —e T Qe 

Furthermore, from (64)-(65), we obtain 


(61) 

(62) 

(63) 

(64) 

(65) 

( 66 ) 


Aj — -Uj l J7q^; A 2 — — I2i j e , 


(67) 


and 

A 3 = A 4 = 7T 4 - 1 l?qJ. (68) 

We already showed that P is a positive definite matrix. Now if we could show that II i for i=l,2,. . . ,4, 
are also positive definite matrices, then the error system described in (54) is asymptotically stable, i.e., 
e(/) — ► 0, or z(t) — ► z m as t — * 00 . 

Now assuming that the SPBM performs slowly varying motion, M, N and G are slowly time-varying 
matrices which can be considered as nearly constant matrices. Consequently from (45) and (46) we obtain 

Aj-M^Kp; A 2 — M _1 K^ (69) 

and 

A 3 - 0; A 4 - 0. (70) 

Next substitution of (69)-(70) into (67 )- (68) yields 

M -1 k p = -nj' fiffi] M~'k d = -n^n£, (7i) 

and 

0 = 0 ~ JT 4 '/Jqj. (72) 
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Now in (71), letting 


( 73 ) 


n i = — M; n 2 = — M, 

ct\ ot 2 

where a\ and a 2 are arbitrary positive scalars, and solving for K p and K<*, we obtain from (71) 

K p = ~cr 1 J 7 qJ, (74) 

and 

K d = -a 2 i?qj. (75) 

In (73), we note that TI\ and 17 2 are positive definite matrices that can be considered as nearly 
constant because the SPBM mass matrix M is positive definite and slowly time-varying. To satisfy (72), 
JI 3 and JT 4 should be chosen such that their determinants approach 00 in addition to the positive definite 
property. To achieve this, we can select /T 3 and 77 4 such that they are diagonal matrices whose main 
diagonal elements assume very large positive values. 

Now integrating both sides of (74) and (75) and using (57), results in 

Kp(0 = K p (0) + a, [ (P 2 q e + P 3 q e )qr dt (76) 

Jo 

and 

K d (t) = K d (0) + a 2 / (P 2 q e + PaqJqT dt (77) 

Jo 

where K p (0) and Kj(0) are initial conditions of K p (t) and Kd(t), respectively and can be set arbitrarily. 

We observe that (76) and (77) represent the solutions for the controller gain matrices of the joint- 
space adaptive control scheme which is as illustrated in Figure 5 mainly based on the errors of the 
actuator lengths of the SPBM and t lie submatrices of P . The computation time required to calculate 
the adaptive control law given in (40) is relatively small because P is a constant matrix and q c can be 
easily computed from the desired and actual lengths. From the fact that the adaptive control scheme is 
very computationally efficient, it can be implemented using very high sampling rates. Consequently the 
assumption of slowly varying motion of the SPBM stated before is valid since the SPBM dynamics is 
considered constant during each sampling interval. Finally, the implementation of the adaptive control 
scheme does not require on-line computation of the SPBM dynamics which is very computationally 
intensive, 

5 Experimental Verification 

This section present results of experiments conducted to evaluate the performance of the joint-space 
adaptive control scheme implemented to control the motion of the SPBM payload platform in the case 
of sudden change in payload and inertial disturbances. The experiment is arranged so that the payload 
platform is tied via a long string to a cinder block of about 15 lb. laying on a table. During an upward 
movement of the payload platform, sudden transition from no payload to full payload occurs at a vertical 
position which lifts the payload off the table, Reversely, during a downward movement, when the payload 
platform reaches a vertical position which sets the payload on the table, it creates a transition from full 
payload to no payload. Referring to Figure 5, for each of the following two study cases, the desired 
Cartesian path are first modeled by a set of desired Cartesian trajectories which are then converted to 
a set of desired trajectories of actuator lengths using the SPBM inverse kinematics. Then by trial and 
error , the controller gain matrices K p and are adjusted until the payload motion can be completed 
with the least tracking errors possible under no payload. The obtained controller gain matrices are then 
used as initial values K p (0) and K d (0) in Equations (76)-(77) which regulate the controller gain matrices 
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to effectively react to sudden payload changes and dynamic coupling effects. The fixed controller gain 
matrices used in the study cases are obtained as 

Kpjixed = 2.68646 Ie, K d, fixed = 80.5 16 1 (^8) 

and the SPBM parameters are: r P = 10.441in., r B = 13.838 in., 0 P = 99.20°, and 0 B = 16°. 

Moreover, the desired performance of the payload platform is embodied in the specification of a 
reference model with the desired damping ratios and natural frequencies which are selected as 

= lOrad/sec; £ = 0,7 for i— 1,2,. . . ,6, (79) 

which yields Di = 100 16 and D2=14 I q. Selecting Q=2 I12 and applying Equations (62)-(63), P2 an d P3 
are computed as 

P 2 = 0.01I 6 , P 3 = 0.0721 I 6 . (80) 

Study Case 1: Vertical Motion 

The objective of this study case is to evaluate the performance of the joint space adaptive control scheme 
in tracking a vertical motion under sudden changes in payload. The desired vertical path is modeled by 


z(t) = zo + for 0 <1<J 

(81) 

vT . T 5 T 

z(t) = vt + — + z 0 , for - <t< T 

(82) 

3 at 2 , 5 T _ 

(t ) = zo + jvT' 2~ ^ or "jj - — ^ ^ 

(83) 


where the travel time T = the travel distance Az = \zj — Zo|, die acceleration a = The initial 
position zo, the final position zj and the velocity v are specified by the user. All above variables are 
expressed with respect to the base platform frame {B}. For this study case we use: zo=19.7 in., z/ = 14.5 
in., and v-0.4 in. /sec. 

Figure 6-13 present the experimental results obtained for the case in which the payload platform is 
controlled to perform the desired vertical motion under two different sudden payload changes, zero to full 
payload and full to zero payload. First starting at a vertical position zq=19.7 in., the payload platform 
moves upwards and lifts the payload up at a vertical position z m = 17 in. After that, the payload platform 
continues to move upwards and stops at a vertical position zy = 14.5 in. Then the platform is controlled 
to move down on the table and sets the payload on the table when it reaches z m . Figures 6 and 7 present 
the desired and actual trajectories of the vertical position z(t) when the fixed gain controller and adaptive 
controller are applied, respectively. Since the fixed-gain controller was by trial and error tailored to zero 
payload, it produces a steady-state tracking error of approximately -0.475 in. in the case of full payload, 
as clearly shown in Figure 8. On the other hand, as shown in Figure 9, as soon as the adaptive PD 
controller senses the change in payload, it adjusts its gains accordingly so that the steady-state tracking 
error is reduced down to about -0.056 in. According to experimental data obtained for tracking of the 
vertical position, the fixed-gain controller has a maximum absolute error of 0.4990 in., and an average 
error of 0.3859 in. For the adaptive controller, the maximum absolute error and average error are 0.1880 
in. and 0.0950 in., respectively. The desired and actual trajectories of the length of the first actuator are 
presented in Figures 10 and 11, respectively. Figures 12 and 13 present their respective tracking errors. 
As manifested by Figures 10-13, the adaptive controller provides better performance as compared to the 
fixed-gain controller in tracking the desired actuator length trajectory. For this case, experimental data 
show that the fixed-gain controller has a maximum absolute error of 0.3593 in., and an average error of 
0.2073 in. For the adaptive controller, the maximum absolute error and average error are 0.1796 in. and 
0.0361 in., respectively. The experimental results of the above study case are tabulated in Table 1. 
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Max Errors 

Avg Errors 

Fixed 

Adaptive 

Fixed 

Adaptive 

z [in.] 

0.4990 

0.1880 

0.3859 

0.0950 

h ['"■] 

0.3593 

0.1796 

0.2073 

0.0361 


Table 1: Errors for tracking the vertical motion 

Study Case 2: Circular Motion 

The objective of this study case is to evaluate the performance of the joint space adaptive control scheme 
in tracking a circular motion under sudden change in payload- The circular motion consisting of three 
segments modeled by 

x(t) = Rcos$ i} y(t) = Rsm$i for U - i <t<U for i = 1,2,3 (84) 

where the circular path radius R = 3 in., and 

*i(0 = + ^ 2 ? (85) 

$2(0 ~ 4" 0j(t — t\)y 

$ 3(0 = <£o - §(<3 - tf (87) 

with <j > o = 0 radian; 4>\ = ^ 1 (^ 1 ) radian, angular velocity cj = (it\ = 0.350 radian/sec and the angular 
acceleration /3 = 2tt/[*i(*3 “ * 1 )] radian/sec 2 . 

For both fixed-gain and adaptive controllers, the payload is first placed on two supporting wooden 
blocks and tied to the payload platform by a string having enough slack so that the payload platform 
can initially move with zero payload. Then at about 10 seconds after the motion begins, the supporting 
wooden blocks are removed to produce a payload step change from zero to full payload. 

Figure 14 shows the actual motions in the x-y plane tracked by the fixed-gain and adaptive controllers. 
As shown by the figure, during the period of zero payload, both fixed-gain and adaptive controllers track 
the desired circle relatively well. However after the introduction of full payload at about the completion 
of 1/4 of the circle, the fixed-gain controller starts degrading its performance and finally gets totally 
off-track after it completes half of the circle. On the other hand, the adaptive controller adjusts its gain 
to adapt to the full payload and tracks the circle with relatively small deviation from the desired circle 
until the end of the motion. Figures 15, 16, and 17 illustrate the tracking errors of coordinates z(t), y(t) 
and x(t), respectively of the fixed-gain and the adaptive controllers. Computation of recorded data show 
that the maximum errors of z(t), y(l), and x(t) are 0.2710 in., 0.3490 in., and 0.4370 in., respectively 
when the fixed-gain controller is applied. Also for the fixed-gain controller, the average errors of z(t), y(t), 
and x(t) are 0.1261 in., 0.1391 in., and 0.1724 in., respectively. When the adaptive controller is applied, 
the maximum errors of z(t), y(t), and x(t) are 0.1500 in., 0.2530 in., and 0.2930 in., respectively, and 
the average errors are 0.0744 in., 0,1060 in., and 0.0941 in., respectively. Figure 18 presents the length 
trajectories for the sixth actuator and Figure 19 its error trajectory. Recorded data show that for the case 
of fixed-gain controller, the maximum and average errors are 0.6620 in. and 0.1733 in., respectively. For 
the case of adaptive controller, the maximum and average errors are 0.1952 in. and 0.0790 in., respectively. 
We observe that the maximum and average errors of the adaptive controller are smaller than those of the 
fixed-gain controller. The experimental results of the above study case are tabulated in Table 2. 
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Max Errors 

Avg Errors 

Fixed 

Adaptive 

Fixed 

Adaptive 

z [in.] 

0.2710 

0.1500 

0.1261 

0.0744 

y [in-] 

0.3490 

0.2530 

0.1391 

0.1060 

x [in.] 

0.4370 

0.2930 

0.1724 

0.0941 

k [in.] 

0.6620 

0.1952 

0.1733 

0.0790 


Table 2: Errors for tracking the circular motion 


6 Concluding Remarks 

This report has dealt with the adaptive control of a Stewart Platform-based manipulator (SPBM) of the 
Hardware Real-Time Emulator (IIRTE) developed at Goddard Space Flight Center to study and emulate 
space operations. Kinematic analysis of the manipulator resulted in a closed-form solution for the inverse 
kinematics whose equations was then applied to develop an iterative solution for the forward kinematics 
using the Newton Raphson Method. Then a joint-space adaptive control scheme was developed using the 
concept of model reference adaptive control and the Lyapunov theorem under the assumption of slowly 
varying motion in the sense that the manipulator motion is slow compared to the adaptation rate of the 
controllers. The gains of the proportional and derivative controllers of the adaptive control scheme are 
adjusted by an adaptation law to effectively react to dynamic and static coupling between joints and 
sudden change in payloads. Being computationally efficient, the adaptation scheme can be implemented 
for real-time applications using personal computers or workstations. Experiments were conducted to 
study the performance of the adaptive control scheme in tracking a vertical motion and a circular motion. 
Experimental results showed that despite step changes in payload, the adaptive controller could track the 
desired motion with negligible tracking errors while the fixed-gain controller suffered from steady-state 
error when tracking the vertical motion and got off-track when tracking the circular motion. Current 
research activity focuses on extending the joint-space adaptive control scheme to a Cartesian-space force 
adaptive control scheme which can be used to provide active compliance to the manipulator. The SPBM 
is used as an active compliance wrist mounted between the T3 manipulator and a selected mechanism 
to emulate docking and berthing in space. Experimental results of the current study will be reported in 
future reports. 
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Figure 3: Platform frame assignment 



Figure 4: Vector diagram 
for the ith actuactor 



Figure 5: The joint-space adaptive control scheme for SPBM 
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Figure 6: Vertical position Figure 7: Vectical position 

trajectories (fixed-gain controller) trajectories (adaptive controller) 


Fixed Gain, Position Error in Z-axis vs Time Adaptive Gain, Position Error in Z-axis vs Time 




Figure 8: Vertical position error 
trajectories (fixed-gain controller) 


Figure 9: Vertical position error 
trajectories (adaptive controller) 




Fixed Gain Leg Length vs Time 



Figure 10: Actuator length 
trajectories (fixed-gain controller) 


Fixed Gain Leg Length Error vs Time 



Figure 12: Actuator length error 
trajectories (fixed-gain controller) 


Adaptive Gain Leg Length vs Time 



Figure 11: Actuator length 
trajectories (adaptive controller) 


Adaptive Gain Leg Length Error vs Time 



Figure 13: Actuator length error 
trajectories (adaptive controller) 







X-Y Planar Response 



X axis [in.] 

Figure 14: x-y planar response of tracking the circular motion 
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Error in y(t) vs lime 



Figure 15: Trajectories of 
position errors in z(t) 


Figure 16: Trajectories of 
position errors in y(t) 
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Error in x(t) vs time 


Leg 6 Trajectory vs time 




Figure 17: Trajectories of 
position errors in x(t) 


Figure 18: Trajectories of the 
sixth actuator length 


Error Leg 6 vs time 



Figure 19: Trajectories of the sixth actuator length errors 






